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Abstract 

Closed loop control of an unmanned underwater vehicle (UUV) in the dynamically 
difficult environment of shallow water requires explicit consideration of the highly 
coupled nature of the governing non-linear equations of motion. This coupling between 
an UUV's six degrees of freedom (6 DOF) is particularly important when attempting 
complex maneuvers such as coordinated turns (e.g. simultaneous dive and heading 
change) or vehicle hovering in such an environment. Given the parameter and modelling 
uncertainties endemic to these equations of motion, then a robust 6 DOF sliding controller 
employing six-element vector sliding surfaces provides a framework in which satisfactory 
UUV control can be achieved in shallow water. 

The vehicle equations of motion are developed and cast in a form that is amenable 
to non-linear sliding control design. A complete 6 DOF sliding controller with vector 
sliding surfaces is then formulated via a Lyapunov-like analysis. The sliding controller 
is then modified via a weighted least-squares approach to work with a particular UUV 
which has only 4 DOF control authority available. The modified controller is shown to 
work well for a variety of commanded UUV maneuvers in the presence of significant 
environmental disturbances and vehicle hydrodynamic parameter uncertainties via 
numerical simulation. Use of the signals generated by the controller are shown to be of 
utility in vehicle buoyancy control. 

Thesis Supervisor: Dr. Dana R. Yoerger, Associate Scientist 
Woods Hole Oceanographic Institution 
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Chapter 1 



Introduction 

1.1 Background and Objectives 

Unmanned Underwater Vehicles (UUV's) have become increasingly popular tools 
for use in a number of ocean research and industrial applications. As the missions for 
these UUV's expand in scope, their capabilities must also increase - not only in terms of 
improved vehicle control and manueverablity but also with regards to satisfactory 
performance in challenging environments. 

For instance, consider the vehicle of figure 1.1 which is currently under 
development at the Naval Undersea Warfare Center (NUWC) in Newport, Rhode Island. 
This 301 inch long, 21 inch in diameter torpedo shaped vehicle - known as the 21UUV 
- is being designed so as to have the capability to perform sophisicated maneuvers in the 
dynamically-challenging regime of shallow water. 

Needless to say, the controller which enables this UUV to attain such capability 
must be fairly sophisticated itself. Not only must the control algorithm be robust to the 
uncertain and changing values of the hydrodynamic coefficients which define the vehicle 
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301 in 




20.94 in 



Figure 1.1 21UUV 

non-linear equations of motion, it must be able to account for the dynamic coupling that 
will occur between the vehicle's various degrees of freedom as complex maneuvers are 
undertaken and/or the wave disturbances are significant - as they would be in shallow- 
water. 

Typically, the coupling in these non-linear equations of motion are subjected to 
various simplifying assumptions so that particular vehicle design objectives can be 
satisfied (e.g. decoupled speed control, inner pitch/outer depth loop control, etc.). Such 
simplifying assumptions also allow the use of sliding controllers of first-order (i.e. scalar 
sliding surfaces) - a non-linear robust control methodology which has proven well-suited 
to control in the ocean environment. 

As alluded to, however, more demanding underwater vehicle maneuvers such as 
hovering require careful consideration of the coupling inherent to the equations of motion. 
Likewise, the operation of such a vehicle in the dynamically difficult regime of shallow 
water necessitates a thorough accounting of this coupling if high performance is to be 
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acheived. As will be demonstrated, a complete 6 DOF sliding controller (i.e. a 6 element 
vector sliding surface) provides an effective framework for handling these situations. 

This study focused on the development of a six degree of freedom (6 DOF) robust 
sliding controller to be used on a variety of UUV designs in dynamically difficult regimes 
like shallow water as well as for complicated maneuvering such as hovering. As few 
practical UUV's have the 6 or more controllable degrees of freedom a method is presented 
which modifies the 6 DOF control signal so that a 4 DOF control authority-available 
vehicle such as the 21 UUV can reap the benefits of a complete, coupled non-linear 
controller. 

A side benefit of the 6 DOF sliding controller is that it produces a signal which 
is ideal for use in buoyancy control systems. In addition, mention is made as to how 
disturbance adaptation/control might be formulated with the 6 DOF controller. 

1.2 Thesis Outline 

Chapter 2 details the development of the general non-linear and coupled 6 DOF 
UUV equations of motion. These equations are formulated with respect to two reference 
frames - vehicle-fixed and earth (inertial)-fixed - and in such a format that readily lends 
itself to non-linear controller design techniques as outlined in chapter 3. Key matrix 
relationships that characterize resultant UUV equations of motion are described, as these 
form the basis of the robust non-linear sliding controller. The sources and values of the 
various body and hydrodynamic coefficients for the 21 UUV of figure 1.1 which will be 
used in the numerical simulations of Chapters 3, 4 and 5 are also summarized. 



14 



Chapter 3 presents the formulation of the complete 6 DOF robust sliding controller 
which is shown to be stable - assuming full 6 DOF control authority - from any vehicle 
configuration except at ± 90 degrees of pitch. 

As full 6 DOF control authority is usually not available, an attempt is made in 
Chapter 4 to develop a method to modify this sliding controller so that lesser degree of 
freedom vehicles (in terms of available control authority) would perform satisfactorily. 
As is demonstrated with the 4 DOF 21UUV, this method - weighted least squares - is 
based heavily on the non-minimum phase relationship between pitch/depth and 
yaw/trackline. Extensive simulations are presented to evaluate the effectiveness and 
validity of this method. 

Chapter 5 briefly delves into two areas related to the controller development of 
the previous chapters - vehicle buoyancy control and wave disturbance rejection/control. 
The earth-referenced vehicle control signal generated by the sliding controller of Chapter 
3 is shown by computer simulations on the 21UUV to be of great utility as an input to 
a variable buoyancy control system. Vehicle response in a wave field is simulated. 

Chapter 6 summarizes the results of this thesis and suggests directions for further 
investigation. 
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Chapter 2 



6 DOF Rigid Body Equations of Motion 

2.1 General Discussion 

In this chapter the 6 DOF rigid body underwater vehicle equations of motion are 
developed with the primary emphasis being the identification of a particularly compact 
and convenient way to express them for exploitation by nonlinear sliding controller design 
techniques as outlined in chapter 3. 

Section 2.2 introduces the standard notation and conventions utilized in underwater 
vehicle design. The two reference frames commonly used to describe the motion of and 
forces/moments on the vehicle - body-fixed and earth-fixed (inertial) - are introduced as 
well. It is of considerable importance to both the development of the equations of motion 
and to the subsequent 6 DOF sliding controller formulation that the two reference frames 
and the relationship between them are thoroughly understood. As might be expected from 
physical intuition, the vehicle linear and angular velocities and corresponding 
accelerations along with the vehicle external forces and moments are best described in the 
body-fixed frame; whereas, the vehicle's linear and angular positions are best described 
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in an inertial reference frame in which commanded trajectories are typically expressed. 
For small angle, non-coupled vehicle maneuvers the distinction between the reference 
frames is slight and can be safely ignored. However, for more vigorous, coupled 
maneuvers (e.g. a coupled dive/trackline commanded trajectory or hovering) and/or for 
operation in the more dynamically-challenging environment of shallow water, this 
distinction must be preserved. 

With this last point in mind, the full 6 DOF underwater vehicle equations of 
motion are derived in the body-fixed reference frame in section 2.3. The resultant 
equations are parameterized in a specific matrix form which turns out to be particularly 
amenable to sliding controller design. The full 6 DOF earth-fixed and body-fixed 
nonlinear UUV equations of motion are summarized in (2.26)-(2.28). 

The final section of this chapter summarizes the values of the hydrodynamic 
coefficients used in these equations of motion and how they were determined. 

2.2 Standard Notation and Reference Frames 

For (rigid body) underwater vehicles which operate in a three dimensional space, 
it is necessary to describe the position/orientation and motion/rotation of the vehicle by 
six independent coordinates - hence, the term six degree of freedom (6 DOF). Typically 
these coordinates are chosen to correspond to the position and orientation and their time 
derivatives with respect to some set or sets of mutually orthogonal coordinate axes (e.g. 
x-, y-, z-axes) fixed to some arbitrary origin which defines a reference frame. Likewise, 
the forces/moments acting on or produced by the vehicle can be referenced to a set of 
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coordinate axes. Standard (SNAME [1950]) notation is used in this study to describe the 
aforementioned 6 DOF quantities and is summarized in Table 2.1. 



DOF 


Motions 


Forces and 
Moments 


Linear and 
Angular Vel. 


Positions and 
Euler Angles 


1 


surge 


X 


P 


X 


2 


sway 


Y 


V 


y 


3 


heave 


Z 


w 


Z 


4 


roll 


K 


p 


* 


5 


pitch 


M 


q 


0 


6 


yaw 


N 


r 


V 



Table 2.1 - Standard Underwater Vehicle Notation 



Note that by convention for underwater vehicles, the positive x direction is taken 
as forward, the positive y direction is taken as to the right, the positive z direction is 
taken as down, and the right-hand rule applies for angles. It is convenient to group the 
linear and angular velocities as a vector quantity v, where: 

v = [u v w p q r] T ^-1) 

the positions and Euler angles as a vector quantity r), where: 

t] = [x y z <t> 0 ty] T 

and the forces and moments as a vector quantity x, where: 

x = [X Y Z K M N] t 

As previously indicated, it is not necessary to choose the same reference frame for 
the three quantities of (2.1)-(2.3). In fact, it is customary and makes physical sense to 



(2-2) 



(2.3) 
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refer v and x to the vehicle-fixed (body) reference frame and to refer rj to an inertial 
reference frame. Note that choosing these particular frames of reference directly 
influences the form of the 6 DOF equations of motion that are to be developed. The 
body-fixed reference frame is chosen to coincide with the vehicle's principle axes of 
inertia. The earth is chosen as the inertial reference frame since underwater vehicles 
travel at low enough speeds so that the acceleration of points on the surface of the earth 
can be neglected. 

As it will be necessary to convert from one reference frame to the other, a 
relationship between v and r\ for the particular positive axis directions that have been 
defined can be shown to be (see Fossen [1994]): 

f| = JOl) v (2-4) 

where: 



^i(ti 2 ) 0 

0 J 2 (r\ 2 ) 



and (5=sin, c=cos, f=tan): 



•AK) 



cij/c0 


-5lJ/C(j)+Cll/S0.S(l) 


styscj) +ci|;c4>s0 


Sl[rC0 


CljfC(j) +s4>S0Sl|l 


-Cljf.s4> +505l[fC(j) 


-50 


C05(J) 


C0C(j) 



(2.5) 



( 2 . 6 ) 



and: 
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1 5(J)f0 C(J)£0 

^ 2 (^ 2 ) = 0 C(J) -s<b 
0 s<\>/cQ c<J)/c0 



(2.7) 



Specifically, (2.5) represents a series of three rotations - about the yaw angle then the 
pitch angle then the roll angle - to get from the vehicle-fixed reference frame to the earth- 
fixed reference frame. 

Note that (2.7) is undefined for pitch angles of ± 90 degrees. To overcome this 
problem, one can use a quaternion representation to describe the coordinate axis rotations 
implied by (2.5) - see Fossen [1994] - or one could define a second body-fixed reference 
frame (different from the first) and switch to its use when approaching the singular 
orientations of the first reference frame. Fortunately, vehicle metacentric restoring forces 
and typical commanded vehicle trajectories preclude operation near these singularities so 
(2.4)-(2.7) are considered adequate for the purposes of this study. 

2.3 Equations of Motion 

Derivation of the underwater vehicle equations of motion has been extensively 
studied over the years and can be accomplished by a number of techniques (e.g. Newton- 
Euler, Kirchoff, Lagrangian). This paper will briefly present the results of a Newton- 
Euler formulation so that the final form of the equations of motion and that some 
assumptions utilized in the sliding controller design are made clear. The interested reader 
is encouraged to consult a suitable hydrodynamic treatise (e.g. Fossen [1994]) for a more 
complete treatment of this subject. 
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It is extremely desirable to derive these equations of motion in a body-fixed 
reference frame so that the hydrodynamic and kinematic forces and moments remain 
constant despite changes in the vehicle's orientation with respect to the earth-fixed 
reference frame. From Newton's Second Law: 

mv = f (2-8) 

where: 



m = vehicle mass 

v = acceleration vector (2-9) 

f = force vector 



it is apparent that the decision to formulate the equations of motion in the body-fixed 
reference frame trades off complexity in the acceleration terms for relative simplicity in 
the force terms. With this in mind, conservation of linear momentum for a rigid body 
yields (Euler's First Axiom of Newton's Second Law): 



m(v 0 + (oxv 0 + o) x r G + to x (o> x r G )) = f 0 



( 2 . 10 ) 



where: 



m - vehicle mass 

o) = angular velocity vector 

o) = angular accleration vector 

v g = vehicle body referenced vel. (2.11) 

v o = vehicle body referenced acc. 
r G = vector origin o - center gravity G 
f = external force vector 

J O 

In a similar manner, conservation of angular momentum yields: 
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/ 0 u + w x (J o u) + mr G x(v Q + ox v 0 ) = m £) 



( 2 . 12 ) 



where: 



I 0 = body inertia tensor 
m 0 ~ a PPtied moment vector 



(2.13) 



Combining (2.10) and (2.12) results in (after some judicious rearrangement of terms): 



where, assuming the x-, y- and z- body axes correspond to the longitudinal, lateral and 
normal symmetry axes of the vehicle (so all cross-inertia terms are zero - usually an 
excellent supposition and especially so for the 21UUV of figure 1.1) and assuming the 
lateral center of gravity corresponds to the lateral axis origin (y G equals zero - again, an 
excellent assumption): 



M RB <J + C *b( V ) V = X RB 



(2.14) 



m 0 0 



0 mz g 0 



M, 



0 m 0 -mz 0 mx 

o o 

0 0 m 0 ~ mx g 0 

0 ~mz 0 0/00 

s •* 



(2.15) 



mz 



‘8 



0 -n ix g 0 



0 /, 0 

0 0 I z 



0 mx 



and: 
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0 

0 



0 

0 

0 



0 

0 



C**(v) = 



0 

-mz c r 

m(x G q~w) 

m(x G r + v) 



mw rnitcP - v) 
-m(z 0 r +x c p) m{Z(fl + u) 
-mu ~ mx cP 



™V -mixtf-W) 
-raw m(z G r +*qP) 
-mtecP-v) -mtetf + u) 

0 v 

-V 0 

I y q -Ip 



~ m ( x <f + v ) 

mu 

mxj> 

-'ft 

l J> 

0 



(2.16) 



and: 



x rb = [X Y Z K M N] t 



(2.17) 



Note, that the rigid-body inertia matrix M m is symmetric, positive-definite (i.e. 
Mrb = (Mrb) T > 0) time-invariant, whereas the rigid-body Coriolis and centripetal 
matrix C m ( v) is skew-symmetric (i.e. C Rfl (v)=-(C Rfl ( v)) T V v € 91 6 ). Both facts will be 
useful in the 6 DOF sliding controller design. 

The generalized vector of external forces and moments x M can be expressed as the 
sum of radiation induced forces x R (e.g. added mass, potential damping and restoring 
forces), viscous damping forces x v , environmental forces (such as waves and current) and 
propulsion forces x. Ignoring the latter forces (for now) and adopting the treatment of x R 
and x v suggested by Fossen [1991] yields: 



x r = ~M a v~C a (v)v -0p(v) v -gOl) 

added potential restoring 

mass damping forces 



and: 



T v = 



(2.19) 



Assuming the vehicle has bottom/top and port/starboard symmetry (which the 
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21UUV of figure 1.1 has), the added inertia matrix M A and the hydrodynamic Coriolis 
and centripetal matrix CJy) can be written as (see Faltinsen [1990]): 



and: 



where: 



X . 0 0 0 0 O' 

0 Y. 0 0 0 Y. 

o 0 Z„ 0 Z. 0 

0 0 0 ^00 

0 0 0 M 4 0 
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0 0 
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c 15 


c 15 
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0 


r 24 

C A 


0 


r 26 

^A 
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c 34 


c 35 
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-c 24 
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C? = -Z*w -Zfi cj 6 = Yj,*Yf 

Cf - C“ - 

C f - -YtV-Yf Cf = X.U 

c” = -Yf>-N, c‘‘ = 




- -V 



The hydrodynamic coefficients in (2.20) and (2.22) follow the standard 
SNAME [1950], Refer to Appendix I for further details. 



( 2 . 20 ) 



( 2 . 21 ) 



( 2 . 22 ) 



notation of 
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Note that for a submerged rigid-body vehicle moving in still water under the 
assumption of an ideal fluid, M A is always positive definite (same condition as M a 
condition which is also almost invariably met for submerged vehicles in real fluids (see 
Wendel [1956] or Newman [1977], for example). Similar properties hold for C A ( v) - i.e. 
for nearly all real fluid conditions C A (v) is skew-symmetric (like C Rli (v)) - see Sagatun 
and Fossen [1991]. 

The potential damping term D p (v) is usually quite small for underwater vehicles- 
especially for operations away from the surface wave zone. Consequently, these effects 
are ignored for this analysis. Even if this term was numerically significant, it is 
dissipative by definition which implies that D p (v) is positive definite (i.e. v T Z) p (v)v > 0 
V v * 0) - an important fact in the development of the 6 DOF sliding controller. 

By the same dissipative nature of the linear skin friction and quadratic vortex- 
shedding drag forces which constitute the viscous damping matrix D v ( v), it also is always 
positive definite. The following form for this matrix is chosen to be: 




£y(v) - - 



0 

0 

0 

0 

0 



V- K<fl 0 o o' 

Y v 0 0 0 Y r 

0 Z„ 0 z 9 0 

0 0 0 0 
0 M w 0 M q 0 

N v 0 0 0 N r 



(2.23) 



The terms on the diagonal of (2.23) represent the drag generated along the zth 
DOF for motion in the zth DOF; the off-diagonal X coefficients - X vr and X wq - represent 
the loss in forward speed generated in a turn and in a depth change, respectively; and the 
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remaining off-diagonal terms capture the coplanar drag generated in turns and/or depth 
changes. Coplanar refers to coupled DOF's like pitch-depth which naturally occur 
together in typical vehicle maneuvers. 

Other terms could be inserted into (2.23) such as K^r (a non - coplanar coefficient) 
- however, (2.23) characterizes the vast majority of the dissipative forces encountered 
during typical maneuvers for vehicles such as the 21UUV of figure 1.1 (see Humphreys 
[1989]). Those terms that are ignored do not affect the positive definite quality of the 
matrix since damping forces by definition are dissipative. 

The restoring force vector g(r\) consists of the gravitational forces acting at the 
center of gravity (jc G =[x G ,y , G ,r c ] T ) and the buoyant forces acting at the center of buoyancy 
y# z fl ] T ) and has the form (assuming both y G and y B zero): 



Defining: 



£(*l) = 



(^- 5)50 

-(>^- 5 ) 0054 ) 

-(W - B)cQc§ 

(z G W - ZbB)c§s§ 

{z g W-z^B)sQ + {XqW-x^cQc^) 






(2.24) 



M = M rb+ M a ; C(v) = av^ + C^v) ; Z)(v) = ^(v) -D^v) (2.25) 

Then the combination of equation (2.14) and (2.25) yields the body-fixe d 6 DOF 
representation of the non-linear equations of motion for underwater vehicles: 
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Mv + C(v)v + £>(v)v + g(Tj) = x 



(2.26) 



To obtain the earth-fixed 6 DOF representation of the non-linear equations of motion for 
underwater vehicles, the transformation of (2.4) must be applied to (2.26) yielding: 

+ ^(v.tOti + Z> n (v,Ti)T| + g^Ol) = x^ (2.27) 

where: 

^ 1 ,(n)=^ _r (Ti)MJ- 1 (T 1 ) 

C n (v,ri) =J- r (Ti)[C(v) -MJ-\ n)j(i\)]J-\n) 
^ n (v,ti)=J- r (ri)Z)(v)J- 1 (Ti) (2-28) 

g,,( T l) = -/" 7 '(Tl)g(Tl) 

X,( f|W r (l|)T(l|) 

(2.26)-(2.28) are used extensively in the implementation of the 6 DOF sliding controller. 

2.3.1 Notes on the Matrices in the Equations of Motion 

Note that M and Z>(v ) are positive definite since they are the sum of positive 
definite matrices and that C(v) is skew-symmetric since it the sum of two skew-symmetric 
matrices. From (2.28), it is straightforward to demonstrate that for nonsingular /(t]), 
M n (t]) and D^(v,r\) are also positive definite, though C^(v,ri) is not skew-symmetric in 
general (see Fossen [1994]). 

Another useful matrix relationship in the development of the 6 DOF sliding 
controller is: 



M - 2 C(v) 



(2.29) 



